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1. INTRODUCTION 

Nowadays, robots are used commently in the industries because of their versatility and 
efficiency [1-3]. The automatic remote control of the robot plays a significant role in real-life application, 
such as nuclear field, construction, and rescue missions. For the excavator robot, in order to perform a 
specific duty, it needs to complete at least two tasks: determining a feasible path from its initial location to 
the destination and then executing the task through control algorithm that has to be designed. According to 
these requirements, the tracking control problem for the excavator robot system is constantly receiving the 
interesting of scientists. The earlier research work mainly focused on modelling work including kinematic 
and dynamic model, modelling of interaction between the machine and the environment, and parameter 
identification [4-10]. Modelling and parameter identification during the operation of machine is very helpful 
for the real-time monitoring and remote control. 

About the control design, during the earlier stage of study on excavator, impedance control 15 
considered as a popular control. In [11], a position-based impedance controller is presented on mini- 
excavator. In [12-13], authors present detail of robust impedance control for hydraulic excavator. The 
impedance control suits to apply for excavator because it can deal with both free and constrain motion [13]. 
However, the algorithm is quite complicated. Recently, many modern control techniques are used in 
trajectory control of excavator arm. In [14], an adaptive controller is presented in controlling excavator arm. 
The stability of system is ensured through mathematical proof and verified by simulation results. However, 
the simulation as well as the explanation of simulation results is quite poor. In [15-16], the fuzzy controllers 
are employed to solve the tracking control problem of the excavator. In these type of controllers, the 
information about the system does not require. However, the stability of the overall system is not shown in 
the mathematic. Nowadays, the PID controller still being used widely in the practice because of its simplify. 
However, tuning of the PID gains to adapt with the change of working conditions is difficult and depending 


Journal homepage: http://iaescore.com/journals/index.php/IJRA 


294 О ISSN:2089-4856 


on the personal experiences. In recent times, in order to deal with this problem, some optimization techniques 
such as artificial neural network (ANN), ant colony optimization (ACO), etc., have been applied to optimize 
the PID parameters. In [17], an genetic algorithm (GA) is used to determine the PID gains for trajectory 
tracking control of robotic excavator. The presented scheme gave the good performances in comparison with 
some given methods. However, the gotten results still have problems needed to be discussed. 

In this paper, a robust adaptive controller is proposed for excavator arm system. The structure of 
controller consists of two parts: the first part is responsible for keeping the stability of the system and the 
second part is used for adapting with the unknown parameters. Therefore, the proposed controller has ability 
to cancel the effect of the uncertainties as well as to keep the tracking error go to zero. Also, the presented 
controller is simple so it is easy to implement. The feasible of the algorithms is demonstrated by Lyapunov 
stability theory and verified through simulation models. The simulation is executed in MATLAB/Simulink 
for both presented scheme and the PD controller under some conditions to ensure that the proposed algorithm 
given the good performances for all cases. 


2. CONTROLLER DESIGN FOR EXCAVATOR ARM 
2.1. Modelling of excavator arm 

Consider an excavator system with structure as Figure 1. The system consists of two subsystems: the 
base is used to move the entire system on the xoOoyo, plane and the arm is used for movement in the zoOoyo 
and zoOoxo planes, This paper concern mainly on the motion control of excavator arm, so the base part and the 
rotation around Ооо axis are considered unchanged. 





Figure 1. Schematic diagram of an excavator 


The Euler-Lagrange model of excavator arm during the digging process corresponding to the 
coordinates of each join as shown in Figure 1 is as follow [18]: 


D(0)0  C(0,0)0 + G(0) + B(O) = Гт- Е, (1) 


where Ө = [0, Ө, 0, | is the position of each joint in the joint space, D(0) represents inertial part, 
С(Ө, Ө) is the Coriolis and centripetal effects, G(0) is the gravity part, В (0) represents frictions; Г is the 


corresponding input matrix, 7 — E li 7, | specifies the torques acting on the shaft of 3 joints, Fz 


represents the interactive torques. The formulas of above parts are given by the following expressions: 
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D, D, Dj, C C С» 1-1 0 
D@)=|D,, D, D4]|,C(06,00-|C, C, С, ,I-|0 1] -1|, О) 

D4 D» D C; Cx Ca 0 0 1 
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where: 

D, = 1„ + Мт, 

Dy = Ру +1, +M 15 + M,, | a; + 2a,r, соз(Ө, + œ) | 

D, = Dy * 1, * Mr; +M „| а; + 2a,7,c0s(8, + œ) | 
+M p |a; + 2а,а,с, + 2a,r, cos (Ө, +Q, )| 
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C. С 
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2.2. Robust adaptive controller design 
Define the error signal: 


e-0,—0 (4) 
where 0, is desired value of Ө. The filtered error surface is chosen as 


x 20-6, + Ye 
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where Y = diag(Y,, Y,, Y,) > 0 
Based on (5), (1) can be written as 
D(0)x - -c(0.0)x—-M (0)5-C(0.0)»-G(8)- B(0)- F, «Tc 


= -С(0,0)х-Ф',+Гт (6) 


where y -6,- Ye, Ф, =| D(6) с(0,0) B(6) G(80) F,| „о, -[ y 1 1 1]. Asuming that 


le. I- (ө) eA] BO Ie 1:1] s[o ool olo] p. б] аала 


= 1,2,3,4,6) are unkown positive constans. 
Consider the following theorem. Theorem: If there exist the scalars p; (i = 1,2,3,4,6) so that 


ю.1= [lov |с(в.8)] A EOL Wal] [о oo] o] os os then the 


following controller and adaptation law can make the dynamic error go to zero. 


гес кау Pe 
Ecl Ix] o, Te, 
|f e 
^ k k бол 
P ‘ac Oe 


(7) 
where К = diag(k;, k», Кз) with ki > O (i = 1, 2, 3), 7, > 0, e, > 0 are constant, © = diag (Cj, 0, бз) > 0, 


= Va 1814 fe o n] 


Proof: Choose the Lyapunove function: 


6 
l. 2 
y --x D(0)k* — 6, 
К=1 21, (8) 
where Ø, = 0, — 0, Гол are estimated values of x, 77: is positive constant. 
The time derivative of Lyapunov function using (6) is as 
. Е 1 . S чы г : B ee 
V --x c(6.8)-- D(a) х+ У — B, p,t X [-D(0) #-C(0,0)5 
k=1 17 
-G(0)- B(0)- F, +17] 
6 1 ; 
=x (-Ф,ф, +Гт)- — D, Pr 
kel 1], (9) 
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Substituting (7) into (9), it is obtained: 


6 6 2 x 2 6 ' 
У = Kx—-x' Og, х Y Ae є ут Ss 
dee +e ile te ix 


< x Kx «llle? o 1 Id av om. . 
x Kx +| Eron E "i 2 P. B, 


PP OM Ls 
< =x" Кх+|х|Ф ф- EB as уд, 
k = k 





(10) 


where 44 = min[ Anin (K ),т, / 27, ]/ max[((D(0)).1/7,] » 0 


r : "V 
o =[p, P)» P Pa Ps Ps] > ё = У (9,8, з (11) 
k=l 


k 


Multiplying (10) by e" gives: 


(12) 


Integrating (12) leads to the following inequality: 
Ó о о 

O<V(t)< (vo-e +— < V (0) + — (13) 
U A U 


Based on above results and Barbalat’s lemma, all error signals will go to zero when time goes to 
infinite-time. 


3. SIMULATION RESULTS 
To evaluate the correctness and suitability of the proposed robust adaptive controller, the algorithm 
was set and simulated in Simulink software with an excavator system given parameters as the following [18]: 
Mbo=1566; Mst-735; Mbu=432; Mload=500; 
Ibo=14250.6; Ist=727.7; Ibu=224.6; 
a2=5.16; a3=2.59; r2=2.71; r3=0.64; r4=0.65; 
Bbo=0.02; Bst=0.02; Bbu=0.02; 
The parameter for the control law is chosen by practical method (trial-and-error): Y =diag (1), K=diag 
(2x10°, 1.5x10°, 10°), m=1, 7, =0.01, #=0.1 
With the purpose of comparison, the simulation is exercuted for both proposed controller and PD 
controller [15].The simulation has been conducted for three cases: 
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- Case 1: The parameters of system are rated, the machine works without payload. 
- Case 2: The parameters of system are rated, the machine works with full payload. 
- Case 3: The parameters of model change, the machine works will full payload. 

In each case, the results were compared with the response of PD controller which was mentioned 
in [18]. Simulation results for Case 1, Case 2, and Case 3 are shown in Figure 2, 3 and 4, respectively. In 
these figures, the solid line (Thetag) represents the reference value of and dashed line (Theta) is for real value 
of à. 
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Figure 2 System responses under condition of without payload and rated system parameters 
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Figure 3. System responses under condition of full payload and rated system parameters 
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Figure 4. System responses under condition of full payload and system parameters variation 


In Figure 2, when system works without load and the parameters of model is rated, the position 
response of joints by using proposed controller and PD controller is absolutely tracked to desired value, and 
the tracking error is trivial. In the second case (Figure 3), the system parameters remain unchanged but the 
excavator work with full payload. The adaptive controller gives the position response of joints almost no 
deviation from desired trajectory, while the PD controller gives a tracking error about 0.05 rad. In case 
system works with full payload and the parameter of system change (Figure 4), the results obtained for the 
adaptive controller are still relatively good. The PD controller gives a maximal tracking error about 0.15 rad. 

From the simulation results, it can be seen that the PD controller can make the system only work 
well when the elements of system are determined. When the system has load disturbance, the tracking error 
appears (0.05 rad) and will increase to 0.15 rad if the system 15 affected by addition disturbances. This 15 
proved that the PD controller will increase tracking error when system has disturbance. Meanwhile, for 
adaptive controller, the responses of system under condition of system uncertainties as well as payload noise 
are so good. 


4. CONCLUSION 

This paper has presented the robust adaptive controller that does not depend on the system model for 
excavator arm. The controller has simple structure, easy to implement but still guarantees good performances 
to the uncertainty of the system. The stability and suitability of the controller were demonstrated by 
Lyapunov stability theory and examined through simulation. The simulation results show that all joints of 
excavator arm absolutely track to desired value even if there is the effect of the load disturbance and the 
impact of the uncertainties of system model. 
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